clear all; close all; clc;

H = 19100e3;
Rz = 6400e3;
Tobr = 12 *60 *60;
Tmod = Tobr /2;
wobr = 2 *pi / Tobr;
c_light = 3e8;
f_0 = 1602e6;

dt = 5*60;
t = 0:dt:Tmod;

rr=[0; Rz];

D = nan(1, length(t));

% цикл для примера

% for i=1:length(t)
%    rsv = (H + Rz)*[cos(wobr*t(i));sin(wobr*t(i))];
% %    plot([0 rsv(1)],[0 rsv(2)]);
% %    xlim([-H-Rz; H+Rz])
% %    ylim([-Rz; H+Rz])
% %    axis equal
% %    pause(0.1);
%    rv = rsv -rr;
%    
%    D(i) = norm(rv);% дальность
%    y_rv(i)=rv(2);
% end

rsv = (H + Rz)*[cos(wobr*t);sin(wobr*t)];
rv = rsv -repmat(rr, 1, length(t));
x_rv=rv(1 ,:);
y_rv=rv(2,:);


D= sqrt(x_rv.^2+y_rv.^2);% дальность


%получаем скорость из дальности
%функция diff сделает массив на 1 элемент меньше

ind = find(y_rv > 0);
V = diff(D)/dt;

df= - V/ c_light* f_0;
figure;

subplot(3,1,1)
plot(t(2:end),df, t(ind), df(ind-1));
xlabel('t, sec')
ylabel('\Delta f, Hz')


subplot(3,1,2)


plot(y_rv)

% figure;
subplot(3,1,3)

hist(df,10)
xlabel('Delta f, Hz')


